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Prufungsantrag gem. § 44 PatG ist gestellt 

<§) Verfahren und Vorrichtung zum Bestimmen der Position, Orientierung und/oder Vferformung eines Objektes 

© Die Erfindung betriffi eine >forrichtung und ein Verfah- 
ren zum Bestimmen der Position, Orientierung und/oder 
Verformung eines Objektes, bet welch em von efnem oder 
mehreren an dem Objekt angeordneten Signalgebem 
(A-G, M) elektromagnetische Signale ausgesendet wer- 
den, wobei die Signalgeber (A-G, MJ derart gesteuert war- 
den, daft die einzelnen Signale voneinander unterschefd- 
bar aind; dlese Signale auf wenlgstens efnen zweidimen- 
alonal aufiosenden Lagedetektor (PSD) projizfert und dort 
in zweldimenslonale Lagekoordlnaten umgewandelt war- 
den und a us den Lagekoordlnaten die Position, Orientie- 
rung und/oder Verformung des Objektes bestimmt wfrd. 
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Beschreibung 

[0001] Die Erfindung betrifft cin Verfahren und cine Vorrichtung zum Bestimmen dcr Position, Orienticiung und/odcx 
Verformung eines Objektes. 

5 [0002] Oftrnals Ut ei w uns c h e n swert die Flugbahn und genaue Bewegung eines Objektes analysieren zu konnen. Bei- 
spielsweise werden im Sportbereich Analysen von Bcwcgungsablfiufei, insbesondere unter Einsaiz modernster Technik 
immer starker nachgefragt So finden heutzutage bercits im groBcn MaBe Videoanalysen statt bci denen beispielsweise 
der zu aiialysierende Schlag eines Tennis- oder Gatfspieiers auf Band aufgezeichnet wild und anschlieflend von einem 
Sportkundigen durch Abapielen des Bandes in Zeitlupe analysieit wild. Aufgrund der zweiifimensionalen Aufzeichnung 
10 eines in drei Dimensiooen stattfindenden Bewegungsablaufs ist es jedocb schwierig, genaue Analyses erstellen zu kro- 
nen. 

[0003] So and bus dent Stand der Technik benats eurige \erfahgen und Vbrridmingep bekarmt, mit denen dig Position 
und Oriflntierung eines Objektes bestirnmt weiden kann. 

[0004] Die Druckschrift HP 0 704 715 A 1 zeigt beispielsweise ein portables System fur die Bestimnmng der Anfangs- 
15 flugbahn eines Golfballes, Basketballes, FuBballes, etc. Hierzu sind auf dem Objekt mehrere leflekderende oder kon- 
trastreiche Flachenmarkierungen aufgehracht Diesc Flachenmarkierungen weiden von einer odex zwei Kamcras aufge- 
nommen, indem eine Kamerablende syncbron mit dem Aussenden eines Blitzlichtes gedflnet wird. Sonrit zeichnet die 
Kamera also ein Lichtmuster aller sichtbaren V\tehenrnfMt*nmp*n m Form von Momentaufhahmen auf. Die Position 
und Orientierung des Golfballes wild anschlieflend aus den erhaltenen zweidimensionalen Kameradaten der Flachen- 
20 markieiungen und Kalibrierungsdaten bestimmt Die Kalibrierungsdaten weiden vor Inbetriebnahme des Systems durch 
A ufa ek fa ne n von 20 Flachenmaikierungen eines Objektes, dessen Position und Orientierung bekannt ist, sowie der 
Brenn weite, Orientierung und Position der Kamera bestimmt \bn der Kamera wird lediglich das von beispielsweise 6 
Maddenmgen stammende lichtmuster aufgezeichnet das somit 6 voneinander ununterscheidbare Lichtflecke zeigt Die 
AuswcrteeLektrooik muB schliefilich jedem aurjgezeichneten Lichtfleck die zugehorige Maddening auf dem Golfball 
25 (z. B. unter Analyse des zuvor anfgenommen Lichtmusteis und einer Bewegungsvorbersage) zuordnen. Dies ist solange 
mSglich, solange sich die Lichtflecke von Aufaahme zu Aumahme nur wemg auf der Kameraaufcahmeflftche verschie- 
ben (wenn der Zritraum zwischen den Autnahmen zu groB ist, ist eine solche Zuordnung nicht mehr eindeutig moglich) 
und die Bewegungsfncdheitsgrade des Objektes, insbesondere hinsichtlich einer Verformung desselben, nicht zu grofi 
sind. 

30 [0005] Der Erfindung liegt nunmehr die Aufgabe ?a ign i nde, das aus dem Stand der Ibchmk bekannte Verfahren und die 
zugehorige Vorrichtung derart weiteizuentwickeln, dafi die Positions-, Orientierungs- und/oder Verfbrmungsbestim- 
mung, insbesondere unabhfingig von der Aufiiahmegeschwindigkeit und der Bewegungsfieiheitsgrade, eindeutig wird. 
[0006] _ Die Erfindung lost dies© Aufgabe jewedls mit den Gegenstanden der Ansprttche 1 und 14. Bevorzugte Ausfuh- 
rungsbeispiele sind in den Unteransprilchen beschrieben. 

35 [0007] Danacfa ist ein Verrahren zum Bestimmen der Position, Orientierung und/oder Verformung eines, insbesondere 
sich bewegenden Objektes geschaffen, bei welchem von einem oder mehreten an dem Objekt angeoidneten Signalge- 
bern elektramagnetische Signale ausgesendet werden, wobei die Signalgeber derart gesteuert werden, daB die einzelnen 
Signale vonemander unterscheadbar sind, diese Signale auf wenigstens einen zwekfimensional auflosenden I ■agedetektor 
projiziert und dart in zweidimensionale Lagekoordinaten umgewandelt werden und aus den Lagekoordinaten die Posi- 

40 tion, Orientierung und/oder >fcrfdxmiing des (sich bewegenden) Objektes bestimmt wird. Vbrteilhaft wird die Positions-, 
Oientiemngs- und/oder Aferfprmungsbesh* fntnung nrit der zusatzlichen Kennzeichnung jedes Signals erstens erleichtert, 
da keine entsprechenden mathematischen Identifikationsverfahren erforderiich sind, und zweitens eindeutig (siehe 
oben). Hierbei konnen bed einer cinfachen moglichcn Kermzdchnungsvariante die Signalgeber Iichtsignale auf unter- 
schiedlichen Fiequenzen aussenden, wobei der Lagedetektor oder ein zus&zlich bei dem Lagedetektor angeordneter De- 

45 tektor die jeweiligen Fiequenzen identifizieren kann. Zudem konnen mehreze Lagedetektoren, rurjedeFrequenz ein La- 
gedetektor, eingesetzt werden, die beispielsweise Filler vor ihrer Aiifnahmefl ache haben und somit trequenzselektiv ar- 
beiten. Diese einrache Kennzeichnung wird erstmals moglich, da bei der Erfindung - im Gegensatz zum oben beschrie- 
benen Stand der Technik - aktiv leuchtende Signalgeber anstcUe von passiven Reflektoren verwendet werden. Je nach 
Zahl der Tr ansl a ti o ns -, Rotations- und ^^ormungsireihritsgrade des Objektes sowie der Anzahl an lagedetektoren ist 

50 eine bestimmte Mindestzahl der am Objekt vorgesehenen Signalgebern erfcsderlich. Diese Signalgebern konnen zu 
Gruppen zusammengefeBt werden und an verschiedenen Orten am Objekt angebrach t werden . Insbesondere werden sol- 
che Gruppen an Stellen des Objektes angebrac^ StcUen des Objektes bewegenkannen. UmfaBtdas 
Objekt beispielsweise ein Schwenkgelenk, so kann je eine Gruppe an Signalgebern an einem Schwenkarm des Schwenk- 
gelenks starr angebracht werden, wobei jede Gruppe abhangig von den Translations- und Rotatioiistreiheitsgraden des 

55 jeweiligen Schwenkarms eine bestimmte Anzahl an Signalgebern umfaBt 

[0008] Bevorzugt wind das Aussenden der Signale von den Signalgebern derart gesteuert, daB die Signale beim Lage- 
detektor zeitiich nachfiinandnr in entsprechenden Zeitfenstem emtreffen. Somit muB nicht zwingend ein trequenzaufld- 
sender Lagedetektor eingesetzt werden, da mit einer entsprechenden Steuerschaltung bei den Signalgebern und einer ent- 
sprechenden Auswerteschaltung beim Lagedetektor (die untereinander synchronisiert sind) zu jedem Zeitpunkt reststeht, 

60 welcher Signalgeber gesendet hat Yarteilhaft kann auch ein sogenannter PSD-Dctektor (position sensitive detector) ver- 
wendet werden, der pro Zeitf enster die Koordinaten eines einzigen auf ihn projizierten lichtfleckes ansgibt (wenn bei- 
spielsweise ein Ti c htsign al sis elektromagnetisches Signal verwendet wird). Es konnen bed dieser Ausfunrungsform bei- 
spielsweise auch zwei Signalgeber gleichzeitig ihre Signale aussenden, sofern sich die Signalgeber an zwei gegentlber- 
liegenden Seiten eines Objektes befinden und der Lagedetektor somit zu jedem Zeitpunkt nur eines der beiden Signale 

65 abhangig von der Orientierung des Objektes cmpfangt 

[0009] Bevorzugt wird zusammen mit jedem Signal eine Ziisatzintormation zum Identifizieren des ausgesendeten Si- 
gnals fibeiUttgeu. Dies kann die oben bereits arujesprochene Frequenz des Signals seiru Alleinativ ist die Zusal2iiifbrma- 
tion bevorzugt als Qxiierung in jedem Signal enthalten. Besonders bevorzugt kann die Zusatziriformation dabei dem je- 
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weiligen Signal auftnoduliert werden. Die Modulation kann one Frequent, Phasen- oder AtnplfairfRTtmrvfril,^ sein, 
Diese Zusalzinfonnation kann dabci zusStzlich odor altcrnativ zu der MaBnahme eingesetzt werden, die Signale in festen 
Zeitfenstern zu sendezL Ersteres erbont die Idcaitifikationssicberticit 

[0010] Sollte der Lagedetektor von seiner Vararbdtungsgeschwindigkeit dazu in der Lag© sein, kann die codiezte bzw. 
modiilierte &isatrinib rmation bevorzugt von dem Lagedetektor direkt decodiert bzw. demoduliert werden. Dies eriibrigt 
eine zusfilzliche EmpfangseinheiL Wird die Frequenz, mil der die einzelnen Signale zeitlich nacheinander gesendet wer- 
den, jedoch weiter erhoht (urn beispielsweise eine feinere Positionsauflosung auch bei hohen Objektgeschwindigkeiten 
zu erzielen), so kann es erfbnterlich werden, die Zusalzinfonnation bevorzugt von einer separaten Empfangseinbeit zu 
ernpfangen. Der L agedetektor beschfiftigt aicb datm allein mil der Ausgabe der zweidimensionalen Lagekoonlinaten der 
eintreffenden Signale. 

[0011] Bevorzugt wild die Zusalzinfonnation von einem separaten Ziisatzinformation-Sender tibcrtragen, der bei- 
spielsweise an dem Objekt angebracht ist Hierzu kann eine Steuerschaltung am Objekt vorgesehen werden, welche das 
Senden der einzelnen Signalgeber steuert Das hierzu verwendete Steuerrignal wild dann ebenfallg ihher den 
mation-Sender an eine entsprecheode mit der Auswerteschalmng gekoppelte Zusatzuifiiimation-Emprangsemheit Gber- 
tragen, insbcsondere drahtlos, beispielsweise per Funk, Ultraschall oder optisch. 

[0012] Bevorzugt wird die Position des rich bewegenden Objektes in Form der drei orthogonalen Koordinatcn im 
Raum und die Orientierung in Farm der drei orthogonalen Drehwinkel im Raimi bestimmt, wobei hierzu wenigstens sie- 
ben Signalgeber verwendet werden. So ist es bereits mit einem Lagedetektor und sieben Signalgebern moglich, die derart 
starr an einem steifen Objekt angeordnet sind, dafi der lagedetektor ihre Signale in jeder Position und Orientierung des 
Obj cktes empfangen kann, die Position und Orientierung in alien drei Translations- und drei Rotations&eiheits graden zu 
bestirnmen. Ist das Objekt in sich nicht steif, sondern beispielsweise ttber Gelenke verformbar, so kann liber entspre- 
chend angeordnete Signalgeber auch die Verf ormung des Objektes bestimmt werden. 

[0013] Bevorzugt werden jedoch objektabhangig (<L h. beispielsweise auch bei groBeren steifen Objekten) mehr als 
sieben Signalgeber verwendet, welche so an dern Objekt angeordnet sind, daB in jeder mogiichen Position und Orientie- 
rung des Objekles immer sieben Signals von sieben verschiedenen Signalgebern auf dem zweidimensionalen Lagedetek- 
tor abgebildet werden. 

[0014] Bevorzugt sind die elektromagnctischen Signale Infrarot-Lichtsignalc, welche vorteilhaft erstens eine gute 
Richtwirkung zeigen und zweitens nicht so stark vom Umgebungslicht gestort werden. 

[0015] Die Erfindung sowie weiter© Vbrtedle und Merkmale der ErfinAing werden nunrnehr anhand bevorzugter Aus- 
fiihrungabeispjele mit Bezug auf die beagpfligte Zri rhmm g naher Briaiiterf Tn <W T^rhnimg ^gmt 
[0016] Fig. 1 in schematischer Ansicht die Anordnung von vier an einem Objekt angebrachten Sienaleebcrn und eines 
Lagedetektors mit Optik, 

[0017] Elg. 2 in schematisrher Ansicht ein erstes Beispiel, bei dem zwei Lagedetektoren PSD1 und PSD2 und ein ein- 
zelner an dem Objekt angebracnter Signalgeber L verwendet werden, 

[001S] Fig. 3 in schematischer Ansicht ein zweites Beispiel, bei dem ein Lagedetektor PSD und zwei an dem Objekt 
angebrachte Signalgeber LI und 12 verwendet werden, 

[0019] Fig. 4 in schematischer Ansicht das zweite Beispiel, bei dem ein Lagedetektor PSD und zwei an dem Obj ekt an- 
gebrachte Signalgeber LI und L2 verwendet werden, jedoch das Objekt im \fergleich zu Fig. 3 andere Bewegunesfrei- 
hcitsgrade hat, ^ . b 

[0020] Fig. 6a, b, c schematisch in drei Ansichten in der xyz- , der xz- und der yz-Ebene die Position und Orientierung 
eines Objektes, dessen Position mit einem Lagedetektor und sieben an dem Objekt angebrachten Signalgebern bestimmt 
wird. 

[0021] Fig. 1 zeigt in schematischer Ansicht eine Anordnung von vier an einem (nicht dargestellten) Objekt, beispiels- 
weise einem Golfrcblagerkopf, angebrachten Signalgebern A bis C und M, die in einer festen Lage zueinander stehen. 
Sollten die Signalgeber beweglich rai e inan de r sein, so sollte fur die anschliefiennV, Auswertung zu jedem Auswertezeit- 
punkt immer die genaue Lage der Signalgeber zuemanderbekaimtse^ 

an einem eine Signalgebereinheit bildenden Dreibein angebracht, mit den drei Signalgebern A bis C an den Beinenden 
und dem Signalgeber M im Zentrum. Diese Signalgeber A bis C und M kOnnen auch an betiebigen Pdsitionen eines star- 
ren Objeldes, d h. ohiie das Dreibem^ 
jekt angebi^ht sem. Bemer konnen mer^^ 

denen Positionen eines Objektes befestigt sein, so dafi entweder verschiedene Bewegungen eines Objekles, z. B. die 
Kopf-, Schulter-, HOft, Arm-, Hand-, Golfschlager- undVoder Beinbewegung eines Golfspielers, oder aber die Bewegung 
eines Tbils eines grQBeren Objektes von mehreren Seiten verfolgt werden kdnnen. Ttn letzteren Fall kann beaspieisweise 
bei einem Objekt, an dessen Voiderseite und ROckseite je ein solches Dreibein angebracht ist, auch bei einer Objekldn> 
hung urn 180°, d. h. bei der Verier- und Ruckseite mil Bezug auf einen Beobachtungsstanc^unkt vertauscht sind, die Ob- 
jektbewegung weiter verfolgt werden. Umgekehrt kann naturlich bei nur einem Dreibein an der \brder- oder Ruckseite 
des Objektes die Objeklbewegung selbstverstandlich auch von zwei gegenttbeiliegenden Lagedetektoren (hinter und vor 
dem Objekt) unabhSngig von da: Position und Orientierung des Objekles verfolgt werden. Somit hangt es ganz von Aus- 
gestaltung des Objektes an, wo die einzelnen Dreibeine oder S ignalgeber bzw. die einzelnen Lagedetektoren angeordnet 
sein mfissen, um alle Objektbewegungen sicher bestirnmen zu konnen. 

[0022] Die Signalgeber A bis C und M kdnnen beaspieisweise emfache in einen Halhraum isotrop ausstrahlende 
TfJichtdifxIen sein, insbesondere Irnrarct-Leuchtdioden. Im fibrigen eignen sich aber alle Arten von Signalgebern, wel- 
che dn elektromagnctisches, akustisches oder optisches Signal aussenden konnen, sofem ein entsprcchender Lagedetek- 
tmwhaaddes^xxtxeSeiid&i S ignals die Rkhtung angeben kann, aus welcher das Signals ausgesendct wurde, 
[0023] In der Fig. 1 ist die sensitive Aumahmeflache eines solchen zwddimensional auflosenden Lagedctektors 1 ge- 
zeigt Auf diese A utrtahmefl a che wird der von den einzelnen Infrarot-I jgvhtHioffcp a l s Signalgeber AhriC und M ana 
gesandte InrVarot-Lichtstrahl fiber eine Projektionslinse 2 projiziert. Der Lagedetektor PSD ist bevorzugt ein PSD-Detek- 
tor (position Bensitive detector), der urrmittelbar die x- und y-Koordinate der Bildpunkte B A bis Be undBn der jeweiligen 



DE 100 54 282 A 1 

Signals der Signalgeber A bis C und M als LagekpondBnatep ausgibt Per vbrteil dieses Lagedetektora tiegt darin, daB be- 
reits detektorintem der Schwerpunkt eines auffallcndeo Lichtfleckcs bestimmt wild und Icdiglich die x- und y-Koordi- 
naicn dcs Schwcrpunkts ausgegeben werden. Ein solchcr kostcngQns tiger und in der AuflOsung hochgenauer Lagedetek- 
tarkann aber lediglich die Schweqjunktkooidinaten eines einzigen LichtfLeckes bzw. eines kornrjlizierteien Iichtmusters 
ausgeben, was jedoch in diesem Fall aus den nachfolgend behandeUen Grilnden vdllig ausreichend ist 
[0024] So werden die optischen Signale der einzelnen Signalgeber A bis C und M namlich zeitlich nachdnander aus- 
gesendcL Das Aussenden kann dabei in eincr sich pcriodisch wiederbolenden Abfolge fest vorgegebener Zeitfenster er- 
folgen. Nach einer Periode, bolder alls Signalgeber nadimnander ihr Signal ausgesendei haben, kann eine kurze Pause 
er folge n, um den Beginn einer neuen Periode zu kennzeichnen. Hierzu kann bei den Signalgebern A bis C und M eine 
entsprechende Steuerscfaaltung vorgesehen sein, die mil einer entsrxechenden dem Lagedetektor nachgeschalteten Aus- 
werteschaltung von Zeit zu Zeit (beispielsweise lediglich zu Beginn der Positioosbestinmwng) synchronisiert wird. 
[0025] Pur die Konnnnnikation nut den einzelnen S ignalgebem A bis C und M (beispielsweise fur deren S teuerung) 
bzw. fur die Synchronisation der einzelnen Signalgeber A bis C und M kann ferner eine optische Sendeeinheit an dem 
Lagedetektor verwendet werden, die die einzelnen Signalgeber A bis C und M und/oder Signalgebereinheiten ansteuert 
und bestimmt, welche Signalgeber A bis C und M und/oder Sigiialgebereinbeiten zu welchern Zritpunkt senden durfen. 
Dazu werden an jedem Signalgeber A bis C und M oder an jeder Signalgeberemheit cine oder mehrere optische Emp- 
fangseinheiten und eine Lo gik s chalhm g vorgesehen, die entscheidet, ob, wie und wann gesendet werden darf. Die Kom- 
munfkan'on bzw. Synchronisation der Signalgeber A bis C und M kann dabei auch liber Punk, Ultrasschall, etc. ertolgen. 
Wird beispielsweise cine Signalgebeieinheit mit mehreren S ignalgebem A bis C und M zum Aussenden ihrer Signale ak- 
uviert, so kann die Logikschaltung der zugehorigen Signalgebereinheit die einzelnen Sendcfcnster furihre jewefligen Si- 
gnalgeber A bis C und M generierert Die Information uber die Abfolge der Sendefenster ist dabei entweder bei der dem 
I^gedetekto nachgeschalteten Auswerteschaltung bekannt oder aber gje wild von der Logikschaltung nochmals zurfick 
an eine entsprechende Emprangseinheit bei dem lagedetektor gesendet und dartn der Auswerteschaltung bercitgestellL 
[0026] Falls es erf brdediefa wild, die einzelnen optischen Signale zus Stzlich oder al ternati v zu der Aussendung in fest 
vorgegebenen Zeitfenstern voneinander unterscheiden zu mussen, konnen die Signale entsprechend gekermzeichnet wer- 
den. Dazu werden die optischen Signale beispielsweise verschieden mcduliert oder codiert Falls die ModYdahonsart 
bzw. die Codlerung genOgend langsam ist, kSnnte der Lagedetektor selbst die optischen Signale dernodulicren bzw. de- 
codieren, um sic zu identifizieren. Wenn j edoch scbnellere Moduladonsarten bzw. Ccdierungen eingesetzt werden, kann 
zusajzlich zu deml^gedetektor, msbesondere in dessen iinmittelbarerNahe, eine optische Bmrrfangseiiiheit (z, B. ein In- 
trarot-Empfanger) verwendet werden, welche aiisschhViffirh das emtreffende Signal demoduliert bzw. decodiert, jedoch 
keine Lagebestmimung vorrrimmt Das demob^ilierte bzw. decodierte Signal der optischen Empf angseinheit steUt zus am- 
men mit dem im wesentlich gleichzeitig ausgegebenen Positionssignal (x- und y-Koordinaten) die Information dar, wel- 
cher Signalgeber A bis C oder M gerade gesendet hat. 

[0027] Pnnzipdell konnen zur Auswertung der von den Signalgebem A bis C und M gesendeten optischen Si gnale ein 
Oder mehrere Lagedetektoren verwendet werden. Bei zwei Lagedetektoren im bekannten Abstand zuemander kann eine 
dreidimensionale Bestimmung der Objekt-Koordinaten ermoglicht werden. Durch verschiedene Emschrankungen der 
Bewegimgsforiheit des Objekles ergeben sich Sonderfatte, welche die anschlieBeude Positionsberechnungen vereinfii- 
chen. Diese SonderfaTle weiden nachfolgend anhand jeweils eines speziellen Beispiels beschrieben. AbschlieBend wind 
ein Beispiel fur den allgemeinen Fall auf gefuhrt, bei dem sowohl die Position (Raumkoordinaten) als auch die Msrdre- 
hungen der Achsen eines ansonsten steifen Objekles berechnet werden k5nnen. Fur ein verformbarcs Objekt konnen zu- 
sStzlich an versctdedeoen Stellen des Objektes, welche sich zueinander bewegen konnen, gerade so viele Signalgeber A 
bis C und M angebracht werden, daB die Bewegung dieser Stellen aus den Signalen der dieser Stelle zugeordneten Si- 
gnalgeber sowie der bcreits bestinnnten Position und Orientierung des gesamten Objektes und der fibrigen beweglichen 
Stellen des Objektes abgeleitet werden kann. " 
[0028] Die Vig. 2 zeigt ein enrtes spezielles Beispiel, bei dem zwei Lagedetektoren PSD1 und PSTO und ein ftinmlnw 
an dem Objekt angebrachter Signalgeber L verwendet werdeiu Mit dieser Konstellation konnen zwar die Raurnkooxdi- 
naten des Objektes, jedoch toeinerlei Verdrehungen des Objektes berechnet werden. Es wird angenommen, daB der Ab- 
stand der I^edetektoren PSD1 und PSD2 bekannt ist. Fur die Poshionsbestimmung des Objektes werden die beiden x- 
undy-Koordiiiatenderaufa^ und PSD2 abgebildeten Bildpunkte des Signalgebers L aus- 

gelesen uiideiiier Auswerteschaln^ 

sition der beiden Lagedetektoren PSD 1 und PSD2 sowie der Brennweite der beiden (rricht dargestellien) Projekrionslin- 
sen vorden Lagedetektoren PSD1 und PSD2 die Richtungen der cmtreffenden Uchtstrahlen ableiten. Der Scfamttounkt 
der beiden Richtungen ergibt die 3D-Koordinaten des Objektes. 

[0029] Bei dieser Variante kann das zeitlich aufeinanderfolgende Aussenden von lichtsignalen von dem Signalgeber L 
beispielsweise den Auswertetakt der Auswerteschaltung triggenx Durch Erbohen der Senderrequenz wird sonrit die Auf- 
15sung der PosMonsbestimmung genauer. UmfeBt das Objekt beispielsweise einen integrierten Geschwindlgkeits- oder 
Beschleumgungsmesser, so kann die Senderrequenz abhangig von der gemessecen Geschwindigkeit bzw. Beschleuni- 
gung eingestellt werden. Auch hier findet somit erfindungsgemSB eine Unterscheidung der einzelnen von dem einen Si- 
gnalgeber L ausgesendeten Iichtsignale start 

[0030] Ein Anwendungsbcispiel fur diesen einfachen Aufbau ware die Messung der Kopfbewegung eines Golfepie- 
iers, wenn Kc^tarehungen nicht weiter bestimrnt werden sollen, 

[0031] Die Fig. 3 zeigt ein zweites spezielles Beispiel, bei dem ein lagedetektor PSD und zwei an dem Objekt ange- 
brachtc Signalgeber LI und 12 verwendet werden. Ferner wird angenommen, daB das Objekt sich lediglich in einer 
Ebene parallel zu dem Lagedetektor PSD bewegen kann und der Abstand dieser Ebene zum Lagedetektor PSD bekannt 
ist AuBerdem soli lediglich eine Drehung des Objektes in dieser Ebene erlaubt sein, d. h. daB die zwei Signalgeber LI 
undl^ebenfallsirmn^ Bei dieser Konstellation konnen die Kbcnndinaten des Objektes in der Par- 

allelebene und der eine Drehwmkel ber^^ 

naten der beiden auf den Lagedetektor PSD abgebildeten Bildpunkte lassen sich die beiden Richtungen der emtrefienden 
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Iichtstrahlen, jeweils von dam Sigiialgeber LI und dem Signalgeber L2, ableiten, Aus den beiden Richtungen und dem 
Abstand der Parallelebene zum Lagedetektor PSD kOnncn dam in eincm ersten Schritt die Koordinaten dcr Sigiialgeber 
LI und L2, und damit die Koordinaten des zugeborigen Objektes (bei bekannter fester Anofdnung der Signahwber LI 
und L2 am Objekt), und in einem zweiten Schritt der eine Diehwinkel des Objekles in dieser Ebene bestimmt werden. 
[0032] Bin Anwendungsbeispiel fur diese Konstellation ist die Beinbewegung Bines Golftpielfira entlang einer Paral- 
lelebene. 

[0033] Bei der Konstellation der Fig. 4 ist noch ein wekcrer-Bcwegniigsfeihdtsgrad unter folgender Annahme be- 
stimmban das Objefct soil rich emergens in emerParallftlpbene drehen und bewegen kflnnen und andererseits soil rich die 
Parallelebene in fie Tiefe bewegen kflnnen. Der Abstand der beiden Signalgeber LI und L2 ist wiederum bekannt Bei 
dieser Konstellation werden also der Abstand der Parallelebene zum Lagedetektor PSD und derDrehwinkel und die Po- 
sition des Objektes innerhalb der Parallelebene berechneL Aus der Kcnntnia, daB sich die Signalgeber LI und L2 in einer 
Parallelebene zum Lagedetektor PSD befinden, und aus einer Bestimmung des Abstandes der Bildpunkte der beiden Si- 
gnalgeber LI und 12 ziieinander kann der Abstand g der Parallelebene zum Lagedetektor PSD wie fblgt bestimmt wer- 
den: 

wobeiL 2 -Li der bekarmte Abstand der beiden Signalgeber LI und L2 voneinander ist, B2 - Bi der berechenbare Ab- 
stand der beiden Bildpunkte der beiden Signalgebcrn LI undL2 undedieBrermweite derProjektionslinse ist Die Fig. 4 20 
verdeutlicht den obigen Sachverhalt 

[0034] Dann kdnnen - wie oben erlfiutert-- aus den x- und y-Koaidinalen der beiden auf den Lagedetektor PSD abge- 
bildeten Bildpunkte die beiden Richtungen der eintreflfenden Iichtstrahlen von den Signalgebern LI und 11 bestimmt 
werden und schlieBlich aus den bestimmten Richtungen und dem Abstand die Position des Objektes in der Parallelebene 
und der Drehwinkei bereebnet werden. 25 
[0035] Ein Anwendungsbeispiel fur diese Konstellation ist die Bestimmung der \far- und Ruckwartsbewegung des 
Kopfes eines Golfepielers entlang einer lime senkrecht zum Lagedetektor und cine sedfliche Bewemma und Verdrehunc 
des Kopfes in der Parallelebene. 

[0036] DieFIg.5aund5bzeigenmzweiAnsichtenm 

Objektes, dessen Position crit einem Lagedetektor PSD mid drei an dem Objekt angebrachten S ignalgebem A, B und C 30 
bestimmt werden soil, sowie die entsprechenden drei Bildpunkte auf dem Lagedetektor Bei diesemBeispiel soli die Po- 
suion des Objektes im Raum bestimmt werden, wShrend die Drehungen des Objektes lediglich auf eine Drehung in der 
yz-Bbene beschrknkl ist Die drei Signalgeber AbisCsind hjerfagi rechtannlreKg i^n^mrW ang^rdnet, ft h sieliegen 
an den Bcken eines rechtwinkugen Dreiecks nrit dem Signalgeber B an der Ecke mit dem rechten "WnkeL Die AbstSnde 
ABund CB der Signalgeber A bis C haben die Lfinge a/2 und stehen - wie gesagt - orthogonal zueinander. Aus dieser 35 
Kermtiiis kdnnen die Abstand^ 
Ebene wie folgt bestimmt werden: 

wobei Gax und G^ die x- und y-Koordinaten des Signalgebers A, Ba* und B^ die x- und y-Koordinaten der Bildpunkte 
des Signalgebers A bei dem Lagedetektor PSD, gA der Abstand des Signalgebers A von der Projektionslinse und e die 
Brennweite der Projektionslinse (bzw. der Abstand Prejektinnslinre mr Aufhahtnftfl^h^ des Lagedetektcxs PSD) ist In AS 
to Fig. 5a iind 5b sind noch ole y-Kboooln^ 

Bbx» Bck und Bay Bey der Bildpunkte der Signalgeber B und C eingezedchnet 

[0037] Fur die Signalgeber B und C ergeben sich aus den Abbildungsgesetzen analoge Gleichungen. Da die drei Si- 
gnalgeber A bis C fur alle Wsrte des Diehwinkel irnrner in der yz-Ebene liegen, gilt (wie auch aus Fisu 5b leicht ersich t- 
lichwird): ^ 

Gax = Gbx = Gcx (3) 



55 



[0038] Der Drehwinkei ♦ laBt sich - wie aus der Kg. 5a leicht erachtlicfa wird - aus den Differenzabstflnden * A - 2* 
bzw. gB - gc ableiten: x «a kb 

Ri-&=j«in(^) bzw. g 3 -g c = ^cos(0) {4) 

[0039] Aus dem Verhfiltnis der Differrazabstande und den AbMldungsgleichungen email man den Drehwinkei $ auch 60 
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[0040] Danrit IfiBt rich der Abstand des Signalgcbera B von der Prcjeknonslinse (und danrit die Objeklposition) auch 
wic folgt scfareiben: 



fcr = 



Am **Bx 



(6) 



10 [0041] Ein An wendungsbeispiei ware die Bcstunmimg der \br- und Rttckwfirtsbewegung des Ruckens cines Golfspie- 
lers entlang einer Linie mit einer zusatzlichen Veidrehung in dieser Richtung. 

[0042] Die Fig. 6a, b und c zeigen in drea Ansichtm in der xyz-, der xz- und der yz-Ebene die Position und Orieniie- 
lung eines Objektes, dessen Pbsition tmt einem Lagedeteklnr PSD und sieben an dein Objekt angehracbten Signalgebeni 
A bis G bestimmt werden solL Bei diesem allgemeinen Beispiel soli die Position des Objektes im Raum sowie alls drei 
15 Di*hwinkel im Raum bestimmt werden. In der Fig. 6a ist die geometrische Anordnung der 7 S ignalgeber A bis G ge- 
zeigt Die Signalgcber A bis G seien so angeordnet, daB die Strccken BA, BC, BE und BG die Langc a/2 und die Stieeken 
BD und BP die Lang© a/3/4 haben. Das Kooxdinalensysteni ist femer so gewShlt, da6 die Orte aller Signalgeber anfangs 
direkt auf den Kooidiiiatenachsen y und zliegen. So liegen die Signalgeber A und C also auf derx-Achse, die Signal- 
geber DundFauf der y-Achse und die Signalgeber E und G auf der z-Achse und der S ignalgeber B im Mittelpunkt der 
20 Koordinatenachsen. Diese geometrische Anordnung der sieben Signalgeber A bis G karm im kartesischen Rooidmaten- 
syslem verschoben und veidreht werden. Dabei wird der Signalgeber B im Mittelpunkt der Anordnung urn die Koordi- 
naten Gb*, Gb ^ und Gfe gegenfiber dem anfBnglichen Koordinateiisystem verschoben. Der Winkei $1 beschreibe erne 
Drchungumdie y- Achse, der Winkei p2 einc Drehung um die x-Achse und der Winkei $3 cine Drehung urn die a-Achse. 
[0043] Die sieben Signalgeber A bis G haben die folgenden Koordinaten imRaum: 











G Cx 








fo m ) 








C:= 




£>.= 
















<G a ) 



















35 F: = 






G o 








<Gj 



(7) 



[0044] DieBUo^unteAbisGalsAbbildu^ 
40 gende Koordinaten: 



-ft) -ft) -ft) -ft) -ft) 
-ft) -ft) 



(8) 



[0045] Die Koordinaten der Signalgcber A und C bis G im Raum kfinnen abhSngig von den Koordinaten des Signal- 
gebeis Bund der drei Drehwinkel $1,$2 und $3 folgendennaBen daigestellt werden: 



= Gey +-cos(&)- <an(&) 



60 



(9> 



G a, = G B , -^sin(^) sin(^)-cos(^)-|cos(^)-8in(^) 
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0 C r=G Bx +~- siii(£) • sin(£) • an(^) - 1 • cos(£) ■ cos(^ ) 
G,» = G*-f cos(fc) siii(A) 



2 

G a = G* +f «iii(A) sui(^)-cos(^)+|.eo8(^) »n(4) 
(10) 



G » = Ga. -a^~sin(^,)cos(^)sin(^)-a^sin(^). cos(ri) 
G^ = + a^cos(&) • cos(&) _ (ID 
= G„ - a^sin(^) • cos(^) • cos( A ) + a^siofo) ■ sinWj ) 



G ft = G B ,-fcos(^). 8 in(^) 



Gj* = G* + a^|sin(^).cos(^).8in(^)+a^|8in(A)- cos(^) 
G«y = G* -a^cos(4). cos(&) 

G f,=G 3 , +a^sin(^).cos(^).cos(^)-a^|sin(^).8in(^) 
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20 
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G*=G ay -|sin(^) ( 12) 
G & = G*-fcos(4).cos(rt) 



(13) 



3S 



40 



43 



G <fc =G Jte +|cos(^). s iii(^) 50 

G<ty=G» +§sm(A) (14) 
Gc=C?a,+fcos(^).cos(^) 

[0046] Ferner ergeben ach - wie aus den Fig. 6b und 6c leicht ersichtlich ward - die folgenden Gleichungen uber das 
Abbildungsgesetz: ^ 

[0047] POr die Signalgeber B, C, D, E, F und G ergeben sich analoge Gleichungen. 

[0048] Aus diesen fiber das Abbildungsgesetz erhaltenen Gleichungen (15) und den oben aufgestellten Gleichungen 
(9) bis ( 1 4) kBnnen die Drehwinkel $ 1 , $2 und $3 und der Abstand Gb z in Ab hfingigkeit der Koordinaten der B ildpunkte 



10 



DE 100 54 282 A 1 

und der jewedls bereits berechnetm Drehwinkel beschrieben werrim. 

Drctawinkd^a 




S5 
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Ab stand gg 



2 U* *J 



(20) 



oder 



a 

2 



Oder 



8b 



_L__Ll 

^.fj__J l] 



(21) 



(22) 



[0050] Die Koordinaten des Punktcs A bezogen auf den Rcferenzpunkt R rageben sich folgendermaBcn. 

Aref:= 



[0051] Die Koordinaien derPunkte B, C, D, E, F und G werden analog bcrcchnet 

[0052] Aus den bestimmten Positional beispidsweise eines geschwungenen Golfschlageis und der bekannten Position 
raneszu trefifenden i Oolfballes lassen sich dann beispielsweise eist die Schwungbahn des Gouschlagers, dann der eenaue 
ltenpunkt des GoUballes (hook, slice, draw, etc.) und die Treffgeschwindigkeit und «/4,K«ffit<4, die Fhighahn des Golf- 
ballese«echnen. Diese kann beispielsweise groBfonnaiig auf einem B Udscbarm voc dem Golfcpiekr zusammen mit dem 
Gtafflentun angezeigt weruen, so daS insgesamt cine vollstandige, absolut realistische Golfsimulation mogUdj wird. 
[0053] Die Amnelderin behSU sich vor; da, Gegenstand des oben aiifgefuhrteo speziellen Auswerteverfahrcn fur die 
POsibons-jmd Onentienmgsbestimiiiiing getrennt von der Unterschmdung der einzelnen Signale von den Sienalgebern 
V ^^ UV ^ l8ei1, Die ? cr G ^ enstandbetriffi ^ Vferfahnai one Vstrichtung zum Bestimmen der Position, OrientLuwr 
und/oder Verformung ones Objektes, bed welchem von einem oder mehrcren mit dem Objekt gekoppelten Signalffebem 
etektrwnagnetische Signale ausgesendet werden, diese Signale auf einen oder mehrere zweidimensional auflflsende La- 
gedetektoren projisert und dort in zweidrmenaonale Lagekoordinaten umgewandell werden, und Ober ranfach Abbil- 
dm|sg«eteeaus den Lagekoordinalen die Position, Orientierung und/oder Verformung des sich bewegenden Objektes 

1. Verfahren zum Bestimmen der Position, Orientierung und/oder Verformung eines Objektes, bei welchem 

a) von einem oder mefarercn an dem Objekt angcordncten Signalgebem (A-G, M) elektroinagnetische Sijmale 
ausgesendet werden, wobea die Signalgeber ( A-G, M) derart gestEuert werden, daB die einzelnen S innate van- 
emander unterscheidbar sind; c 

b) diese Signale auf werrigstens einen zweidlmensional auflosenden Lagedetekror (PSD) propziert und dort in 
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l** 9 } Aus den berecfaneten Drehwinkeln (frl, $2 und $3 Bowie dem Abstand gs kfinnen Obex die Gleichungen (9) bis 30 
(14) die Koordmaten der Punkte A, B,C,D,E, FundG im Raum berechnet werden. Es kann hierfur ein Rcferenzpunkt 
festgeiegt werden, welcher fblgende Koordinaten haL 
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zwe irlimpjisinn a l n LagBkocidinalen amgewandelt warren- nn d 
9 ^L^T I^ootdinaien die Potion, Orientierung und/oder Mrfonnung des Objektes bestimmt wirxL 

2. ^hren nach Anspruch 1, bei welchem das Aussenden der Signale von dsn SignalgebernfA-G, Ml derart ac- 
steuert wud, daB die Sigiialebeiml^gedetektor (PSD) reitlich nacheinander in ent^SZ ^tf^tem^M 

3. \fertahren nach Anspruch 1 oder2,bei welchem zurammen nritjedem Signal eine Zusaudnfonnation zum Iden- 
tifizieien des ausgesendetcn Signals Obertragen wird. ^ n jataH 
c Anspruch 3, bei wekhem die Zusateinfbnnanon als Cotherung in jedem Signal enthallen ist. 

« vZS^ ""^ ^P™* 4 ' *« welchem die Ziiaatzmformanon dem jeweiligen Signal atifinoduliert wild 

aJSSSSSS'^EJS 4 °^ 5 ' wekhem die codiertebzw. modulieite ZusaSnfonnation von demLage- 
detektor (PSD) direkl decodiert bzw. demoduliert wird. vuuucmuigc- 

L 1 a^^„-tnX^S e S Bn ^ WE,CheIndiB information von einem separatee 

lO^ferfahren nach Anspruch 9, bei welchem das Steuersignal optisch, per Punk oder per Ultraschall (ibertragen 

^nii^^f^^!! 0 ™ rb =8 ehend * n AnsprOche, bei welchem die Position des rich bewegenden Objcktes 
?£oidinalen Orientiening inR^nnder dmi orthog^na^DiehwS 

^ ""^^ bestimn * Wird, wobei wemgstens sechs Signalgeber (A-G) verwendet werdenT 
liVHftnra nach Anspruch 11, bet welchem objektabhangig mehr als sechs Signalgeber (A-<5. M> verwendet 
werden, welche so an dem Objekt angcordnet sind, da£ in jeder mOglichen Posidon!olXung^ ) \^^5 

UchnSSe S riS Ch eiDCm ** vtMbclEebendcn AnsprOcue, bei welchem die eleknomagnetischen Signale Infrarot- 
14. Vbrrichtung nim Bestimmen der Position, Orientierung und/bder Vferfarmung eines Obiektes mit 

riJ^f? °^ mC ^'. " ?™ °9 ,kt an « eorllllEtei1 Signalgeben. (A-G, M) zum Aussenden efcktromagne- 
!3£b^S S^nalgeber (A-G, M) derm gesteuert werden, daB die Signale vonenMnderun^ 

fi^^fcl^f^^^?^ Lagedetektor (PSD), der derart aiisgestaltet ist, daB die anf 
ihn projunerten Signale in zweiduneosioiiale Lagekoordinaten umgewandelt werden- und 

genaeTo^e^^^^ 11 ^ ^ ^ ** «™~ 

If" ^S^c^^^^^J?!^ Steuerachaltung zum Steuem der Signalgeber (A-G, M) derart, daB 
Stef £5b£**^" Lagedetektor (PSD) zeitlich nacheinandeHn entsprechendeT^tfon- 

zL^S5 T« A T^ 13 ^J 4 * W Welcher j edcr Signalgeber (A-G, M) derart ansgestaltet ist, daB er 
zusanmmn mit dem Signal erne Zusatzinformafion zum Idennflzieien dea von ihm ausgeaandten Signals ObSi 
info^^r'^ hAn8I ^ h 16 - ^welcher jeder Signalgeber (A-XJ, M) dexart a^tal tet ist,TTdilzS- 
mformauon ala Codierung m dem von dem Signalgeber (A-G, M) gesendeten Signalenthalten isL 
mfc^^^ nach Anqanch W wetehct Jeder Signalgeber (A-G, M) derart ansgestaltet ist, daB die Zusatz- 
mformanon dem von dem Signalgeber (A-G, M) gesendeten Signal au&noduliert iat 

l^n^^^r^^er^^ 
SgetSazutrSn'v^^ 

IL^SS ^ ^^Anspruche 14 bis 20. bei welcher ein mit den Signalgebem (A-G, M) gekoppelter 
^atzmformanon-Sender zum Senden der Zusatzinformation vorgesehen isL * 11 

^h^t&f* ?T ^ ^f^ 116 15 bis 21 - W wiener eine Steuersignal-tWagun^scinheit zum 
Sa^r^rT 1 S,£UerS, « nals ^ ^ Si^'-r (A-G, M) voxgeseTen ^^^oTa^I^X 

^Vbrrichtung nach Anspruch 22, bei welcher das Steuendgnal optisch, per Punk oder per Ultraschall Obertragen 

24^>rrichbjng nach einem der Anspruche 14 bis 23, bei welcher wenigstens sechs Signalgeber (A-G) verwendet 
d^S 'ZSZlZTVZZP"* ^K^* « die Posinnn des aich taS^ObJKtap£! 

KoordmatenimRanmund die Orientierung in Form der did oflhog^en D^inkeTun 

25^mchtung nach AnapruA 24, bei welcher objektabhangig mehr als sechs Signalgeber (A-G, M) verwendet 
Z^^V.T " ^fH^g^dnet ^ oaB in jeder mogUchen Po^don!oX 1 ti e rung ^i/o^^ 
SSStX^ 113 VCrSChiCdeOCn Signa ^ eberD zwddimensio- 
Lich^Sl 31:11 01116111 ^ VOrbCIBehenden Aas P^^ bei welcher die elektromagnetischen Signale Infraxot- 
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27. \famchtung nach einem der Anspriiche 14 bis 26, bei welcber der Lagedetektar (PSD) eui PSMtetektar ist 

Hierzu 5 Seitefti) Zcichnungco 
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